float32 duration
float32[] q
float32[] kp
float32[] kd
